#include "nav_utils/manual_traj_optimizer.h"
#include <ros/ros.h>

int main(int argc, char *argv[])
{
    ros::init(argc, argv, "manual_traj_optimizer");
    ros::NodeHandle nh;

    Planner::ManualTrajOptimizer manual_traj_opt(nh);
    manual_traj_opt.optimize();

    ros::Rate rate(1);
    while (ros::ok())
    {
        manual_traj_opt.display();
        rate.sleep();
    }

    return 0;
}
